/**
 * @author Ramon Loureiro
 * @version March  2011
 */

import lejos.nxt.*;
import java.io.DataInputStream;
import java.io.DataOutputStream;
import java.io.IOException;

import lejos.nxt.comm.BTConnection;
import lejos.nxt.comm.Bluetooth;



public class NXToffRoader
{

  public static void main(String[] args) throws Exception {

        IntercambiadorDatos DE = new IntercambiadorDatos();
        CommonParameters ctrl = new CommonParameters();

        ControladorVehiculo m = new ControladorVehiculo(ctrl, DE);
        m.start();

        THREADControladorMotores tcm = new THREADControladorMotores(Motor.C,Motor.B, DE);
        tcm.start();

        THREADControladorDistancia ind = new THREADControladorDistancia(DE);
        ind.start();

        while (!Button.ESCAPE.isPressed()){
            LCD.drawInt (DE.getContador(),5,2,1);
            LCD.drawInt ((int)DE.getTripleDistancia(0),3,2,4);
            LCD.drawInt ((int)DE.getTripleDistancia(1),3,8,5);
            LCD.drawInt ((int)DE.getTripleDistancia(2),3,12,6);
        }

  }

}

